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Precede et disposltif pour la detection et la localisation d'obstacles dans fenvlronnement d'un vehlcule. 



Vn L'invention conceme un proc^d de detection et de lo- 
usation d'obstacles dans Tenvlronnement d'un v^hicule. 
A cet effet, II comprend les stapes consistant k ^mettre des 
signaux en direction dudit envlronnement k partir d'une plu- 
rality de radars (2) disposes sur le vehlcule, k ddduire des 
signaux recus en 6cho les probabilites d'occupation par un 
obstacle d un ensemble de cellules ^Idmentaires (9) dudit 
envlronnement, et k fusionner les probability relatives k 
chacune desdites cellules. 
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Proced6 et dispositif poiir la detection et la localisation 
d'obstacles dans renvironnement d'un vdhicule 

La presente invention concerne un precede et un dispositif pour la detection et 
5 la localisation d*obstacles situes dans I'environnement d'un vehicule arrete ou 
en mouvement. 

Une fonction importante de la robotique mobile concerne ia detection des 
objets ou obstacles situes au devant ou sur le cote du vehicule porteur. dans la 
10 mesure ou ceux-ci peuvent entraver son mouvement et doivent etre 
contournes, ou necessitent son arret complet par souci de securite ou, au 
contraire, sont suffisamment distants ou dans une direction telle que le 
vehicule peut continuer son chemin sans ecart. " 

15 Un aspect secondaire de cette detection consiste a exploiter une cbnnaissance 
a priori du positionnement (absolu) de Tobjet detecte par rapport a une carte ou 
un site plus vaste. pour qu'en detectant cet objet et en mesurant ses 
- coordonnees (site et distance) on puisse en retirer une information sur la 
position absolue du vehicule lui-meme. 

Un moyen commode pour detecter des objets situes dans la peripherie d'un 
vehicule et permeitant d'en mesurer les coordonnees consiste a utiliser des 
capteurs a ultra-sons: ' • 

25 Selon cette technologie bien eprouvee. une onde acoustique est emise 
periodiquement et, se trouvant reflechie par les objets cohstituant des 
obstacles a sa propagation, revient vers le capteur apres un temps de retard, 
lequel depend directement de la distance de I'objet ainsi detecte, 

30 Pour assurer la detection peripherique d'un vehicule, ii convient de disposer un 
nombre suffisant de tels capteurs sur son pourtour en fonction de Tangle 
d'ouverture du capteur elementaire. Ce nombre estd'autant plus eleve que les 
capteurs auront un lobe de detection eitroit. 

35 Lutilisation de ces capteurs fournit une information de distance par rapport a 
un obstacle, mais Tinformation d'orientation angulaire est d'autant moins bonne 
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que les capteurs sont a lobe large. En effet, dans la mesure ou un capteur voit 
un obstacle donne non pas en un point de I'espace mais de maniere ambigue 
en tous points situes a egale distance, si Ton associe plusieurs capteurs pour 
assurer la.couverture du perimetre du vehicule, rindetermination de la position 
angujaire des obstacles detectes peut etre excessivement grande.^ 

A contrario, une detection plus fine exige un nombre superieur de capteurs 
elementaires, a lobes plus etroits, ce qui accroit le cout global de la detection. 

Un autre inconvenient de rutilisation de capteurs a ultra-sons est leur tres 
grande sensibilite aux perturbations acoustiques exterieures, aux anomalies de 
reflexion sur certains obstacles, ainsi que la sensibilite au vent des ondes 
sonores, Techo pouvant meme etre souffle et ne jamais revenir a sa source. 

Lia presente invention vise a pallier ces inconvenients. 

A cet effet. ['invention a tout d'abord pour objet un precede de detection et de 
localisation des obstacles situes dans Tenvironnement d'un vehicule. 
caracterise par le fait qu'il comprend les etapes consistant a emettre des 
signaux en direction dudit environnement a partir d'une pluralite de radars 
disposes sur le vehicule, a deduire des signaux re^us en echo les probabilites 
d'occupation par un obstacle d'un ensemble de cellules elementaires dudit 
environnement, et a fusionner les probabilites, relatives a : chacune desdites 
cellules. 

.pes^algprithmes de fusion d'informations sont deia connus dans la technique. 
Tputefojs le fait de fusionner des .probabilites d*occupation de cellules 
elementaires, ces probabilites etant elles-rnemes obtenues a partir de signaux 
radar, peut donner, avec la technique selon Tinvention, des resultats tout a fait 
surprenants par leur precision, permettanLmeme Ja cartographie des obstacles 
detectes et rendant done, possible, leur evitement ainsi que la localisation du 
vehicule . lui-meme, dU : fait de la .grandS: qualite de la modelisation de 
Tenvironnement ainsi effectuee. 

Par ailleurs, contrairement aux capteurs a ultra-sons, les radars peuvent etre 
utilises en exterieur et par tout temps. 



Enfin on a pu constater que I'invention permet meme d'utiliser des radars de 
performance individuelle relativement mediocre sans alterer ies resultats de la 
modelisation globale. 

Dans un mode de realisation de I'invention. la fusion est effectuee sur Ies 
valeurs des probabilites foumies par une plural ite de radars, et notamment 
deux radars. ' • 

Dans ce cas, la fusion est effectuee de maniere spatiale de maniere a associer 
des donnees retoumees simultanement par un sous-ensemble de radars ayant 
detecte un meme obstacle sous des angles differents. 

Dans un autre mode de realisation, la fusion est effectuee sur la valeur de la 
probabilite fournie par un radar et la valeur de la probabilite anterieurement 
connue pour la meme cellule. 

La fusion est dans ce cas effectuee de maniere tempdrelie, le meme obstacle 
etant vu successivement par un meme capteur qui aura avance en meme 
temps que le vehicule: Dans ce cas. i'operation de fusion est appliquee a la 
valeur deja affectee a la cellule. 

Gn peut deduire- des signaux re?us en echo une information de distance et une 
information angulaii-e sur Ies obstacles et determiner lesdites probabilites 
d'occupation a partir de ces Informations. 

De preference on prevoit une etape de seuillage des resultats de la fusion de 
maniere a obtenir une carte depouillee des artefacts divers pouvant provenir 
de reflexion speculaires ou multiples, des ondes radars emises. 

Selon un mode de realisation particuliere de I'invention, le signal emis par Ies 
radars est module en frequence, le signal re^u en echo est melange a une 
fraction du signal emis pour, apres elimination de la frequence porteuse. former 
un signal de battement, et Ies impulsions de battement sont comptees pendant 
un intervalle predetermine pour fournir la distance d'un obstacle. 
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En variante, cette distance peut etre fournie par transformation de Fourrier. 

; , * t ■ • 

1 ■ ■ • ■ _ ■ , ■ ... • ' ■ 

Avantageusement, remission de cheque radar dure un temps : limite et la 
logique de repetition peut meme etre codee en vue de Tidentification de la 
source. 

L'invention a egalement pour objet un dispositif pour la modelisation de 
Tenvironnement d'un vehicule, caracterisee par le fait qu'jl comprend une 
pluralite de radars montes sur le vehicule et une unite de traitement agencee 
pour fusionner les donnees fournies par les radars. 

Grace a roperation de fusion, on peut sans inconvenient choisir des radars a 
lobe large, done de performance moyenne et de cout peu eleve. 

' * ' . • ■ ' " ■ ■ ■ 

On observera que les radars de ce type^ notamment les radars Doppler 
courants, sont generalement utilises en mesure de vitesse alors qu'ici. c'est la 
distance qui est mesuree a titre principal, la mesure de vitesse n'etant 
eventueljement utilisee qu'a titre accessoire. De surcroit. alors que les radars 
utilises en vue de mesures de distances sont generalement des radars 
fqnctionnant en impulsions, on utilise ici de preference des radars a emission 
continue et fonctionnant en modulation de frequence. 

On decrira maintenant a titre d'exemple non limitatif un mode de realisation 
particulier de Tinyention. en reference aux dessins schematiques annexes dans 
lesquels : - ■ - . '-^ 

- la figure 1 est une vue schematique de dessus d'un vehicule muni des 
moyens de l'invention. . . 

- la figure 2 est un diagramme fonctionnel de ces moyens, 

- la figure 3 illustre les signaux emis par les r^adars, 

- la figure .4 represente la modelisation de Tenvironnement du vehicule. 



- la figure 5 illustre la fonction de repartition des probabilites d'occupation d'une 
cellule par un. obstacle en fonction de la distance au foyer d'une antenne et 

- la figure 6 illustre la fonction de repartition des probabilites d'occupation de 
cette cellule en fonction de I'ecart angulaire entre 'sa direction et I'axe de 
I'antenne. 

La figure 1 represente un vehicule automatique muni d'une plate-forme 1 sur 
;laquelle sont montes une pluralite de radars 2, par exemple une vingtaine. Les 
radars 2 sont ici des radars a lobe large, c'est-a-dire d'angle d'ouverture 20 
typiquement compris entre 15° et et 120'. On rappelle qu'un angle 29 important 
est recherche pour obtenir une bonne couverture peripherique autour du 
vehicule avec un nombre de capteurs aussi redtiit que possible. 

Les radars 2 sont ici des radars FMCW a modulation de frequence et a 
emission continue ou par fenetre temporelle. 

Les radars 2 sent places a la peripherie du vehicule de maniere a obtenir une 
vision aussi complete que desiree de son environnement. La finesse de la 
couverture de detection et de la modelisation en general/depend directement 
du nombre de radars utilises dont les lobes individuels peuvent se rejoindre 
arbitrsirement cornrnexeia est repesente vers I'avant (fleche 3) et le cote du 
vehicule. • .• • • ' . 



On voit sur la figure 2 trois des antennes radars 2a, 2b et 2c." Chacune de ces 
antennes est reliee par I'intermediaire d'un circuit d'inteface 4a, 4b, 4c 
respectivement, a une unite 5 susceptible d'elaborer les signaux de 
declenchement Sa, Sb et Sc respectivement des radars. En variante, les 
signaux de declenchement peuvent etre cbmmuns a tous les radars. 

Les signaux Sa, Sb, Sc sont modules en frequence comme represente a la 
figure 3. Une frequence porteuse Fp est modulee' par une onde en dent de scie 
de frequence Af. Cette generation de frequence peut etre assuree au niveau de 
I'unite 5 par une diode oscillatrice GUNN. 
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Optionnellement. pour chaque signal Sa, Sb. So, remission modulee dure un 
temps limite D. On facilite ainsi la dlfferenciation des signaux regus ainsi que 
i'extraction des informations recherchees. Par ailleurs. en codant la logique de 
repetition des emissions, c'est-a-dire la duree T sur la figure 3. par example 
5 selon un modele pseudo-aleatoire, il est possible de personnaliser chacune 
des emissions. On peut ainsi en particulier faire evoluer plusieurs vehicules 
dans le meme environnement. 

Le signal recu en retour par ch.aque antenne 2a, 2b. 2c est traite dans une 
10 unite de traitement analogique 6a, 6b, 6c re.spectivement. 

Le signal re9u est dephase par rapport au signal emis. Par melange dans 
I'unite 6 correspondante avec une fraction du signal emis. apres elimination de 
la frequence porteuse, un signal de battement S une frequence type de I'ordre 
15 de 1 kHz est obtenu. 

- - > 

Le signal est tout d'abord filtre pour eliminer les hautes frequences, 
cqrrespondant aux obstacles les plus eloignes. On ne retient ainsi que.le signal 
retrodiffuse par le premier obstacle rencontre, qui. est ensuite traite par 
20 transformee de Fourrier, . . 

Par ailleurs, la comparaison de la frequence de Tonde porteuse retrodiffusee et 
de celle de Tonde porteuse du signal emis donne la frequence Doppler F<j qui 
est proportionnelle a la vitesse de rapprochement ou d'eloignement du vehicule 
25 , de rpbstacle delecte. selon la rel^^^ 

- , - . . .. v,= 1/2XFd • 



30 



ou A. = c/F (Vitesse de propagation/frequence d'emission) 

[-'information de. .vitesse n'est pas necessaire a !a mise en oeuvre de 
rinvention. Sa disppnibilite constitue neanmoins un avantage dans les 
applications. 

35 Les informations de distance et vitesse numerisees sent fournies par les unites 
de traitement analogiques 6a, 6b. 6c au processeur numerique 7. 
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Le processeur 7 est constitue pour I'essentiel d'une unite de calcul susceptible 
d'acceder a une memoire 8. 

A chaque element de la memoire 8 est associee une cellule elementaire 9 de 
Tenvironnement du vehicule. Le contenu de chacun de ses elements de 
memoire represente la probability pour qu'une cellule particuliere, reperee par 
son site ^ et sa distance d par rapport au vehicule, renferme un obstacle. 

La figure 4 represente 2 radars 11 et 1 2 ayant chacun detecte un obstacle, le 
premier a la distance d^ et le second a la distance d2. Par convention, on 
decide que la probabilite d'occupation d'une cellule par un obstacle est 
comprise entre -1 (la cellule est certaihement ndn occupee) et +1 (la cellule est 
certainement occupee), la probabilite p = 0 correspondant a I'incertitude. 

Connaissant la position du foyer de chaque antenne ainsi que son axe de 
visee, on affecte a chaque cellule une probabilite d'occupation fonction de la 
distance a laquelle un obstacle a ete detecte, de la distance de cette cellule au 
foyer de I'antenne et de I'ecart angulaire entre I'axe de visee de I'antenne et la 
direction de la cellule. A titre d'exemple, la figure 5 represente la fonction de 
repartition des probabilites d'occupation d'une cellule en fonction de sa 
distance au foyer de. I'antenne du radar 11, et la figure 6 la fonction de 
repartition des probabilites en fonction de I'ecart angulaire a entre I'axe de 
cetfe antenne et la direction consideree. La probabilite maximale est bien 
entendu rencontree pour la distance d-i et dans la direction de vis^ de 
rantenne. ■ ■ ".. "' . • ■ ; .:■ v- 

• ' . ^ :. ■ ■ • •■ .. ; . .. ■ 

Les differentes zones, de probabilites sont portees sur les figures 4 k 6. La 
zone B de probabilite ' positive^ sur ia figure 5 correspond a deux bandes 
annulaires de part et d'autre du cercle de rayon di. On verifie par ailleurs sur 
la figure 5 que seul le premier obstacle rencontre est pris en compte puisqu'au- 
dela d'une certaine distance (zone D) fonction de d-j aucune information n'est 
apportee par la mesure:: De meme sur !a figure i6, aucune information n'est 
apportee par la mesure en dehors du lobe d'emissicn (zone A). 
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Les niveaux possibles de quantification entre les valeurs -1 et +1 dependent 
des performances du materiel de calcul utilise, la performance globale de la 
representation de I'environnement etant d'autant meilleure que ces niveaux 
sont plus nombreux. 

Lorsque Ton a de cette maniere affecte a une cellule donnee, par la mesure 
effectuee a I'aide du radar 11, une probabilite p1 d'occupation de cette cellule 
par un obstacle et, par la mesure .effectuee a I'aide du radar 12, une probabilite 
p2. on met en oeuvre Taigorithme de fusion suivant : 

- si p1 > 0 et p2 > 0. 

F(p1, p2) = pi + p2-p1.p2 . - ■ 

- Si pi < 0 et p2 > 0 

• ■ • , . . . . ■ ... - ' - .J 

F(p1.p2) = p1 +p2 + p1.p2 

- si pi < 0 et p2 < 0 ^ . 

, : . . : pt + p2 

F(p1,p2),= _ , - 

, 1-Min(p1;p2) - -r.:; 

-,Ce|t algprithme peut etre mis en oeuvre de la fagon decrite ci-^essus. c*est-a- 
dire spacialement. en fusionnant les informations de probabilite provenant de 
deux radars, ou encore de maniere temporelle. en utilisant Tinformation de 
probabilite; provenant d'un seul radar et en la fusionnant avec la probabilite 
deja presente pour la cellule consideree dans la memoire 8. 

Les probabihtes .d'occupation de J'espace s'expriment continument entre -1 
(cellule certainement vide) et +1 (cellule' certaihement occupee). On realise 
ensuite un seuillage des resultats de la fusion brute de maniere a obtenir une 
carte de renvironnement du vehicule sur laquelle sont portes !es obstacles. 



On peut d'ailleurs ameliorer la representation de cette carte en lui faisant subir 
une operation morphologique de type "fermeture" (dilatation - erosion), connue 
dans le domaine du traitement d'image. 

La carte ainsi obtenue fournit ainsi une informalidri preciise sur renvironnement 
du vehicule et permet : 

- son evolution avec evitement eventual d'obstacles ; 

- sa relocalisation par comparaison entre les emplacements mesures des 
obstacles et une connaissance a pnori de ces obstacles. 

On peut par ailleurs envisager d'autres systemes emetteurs-recepteurs de 
signaux que le radar, par exemple de telemetres laser ou infrarouge ou des 
sonars. ^ • 
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REVENDICATIONS 

1. Procede de detection et de localisation d'obstacles dans- I'environnement 
d'un vehicule, caracterise par le fait qu'il comprend les etapes consistant a 
emettre des signaux en direction dudit environnement a partir d'une pluralite de 
radars (2) disposes sur le vehicule, a deduire des signaux re^us en echo les 
probabilites d'occupation par un obstacle d'un ensemble de cellules 
elementaires (9) dudit environnement. et a fusionner les probabilites relatives a 
chacune desdites cellules. 

2. Procede selon la revendication 1 , dans lequel la fusion est effectuee sur les 
valeurs des probabilites fournies par une pluralite de radars, et notamment 
deux radars. 

3. Procede selon Tune quelconque des revendications 1 et 2, dans lequel la 
fusion est effectuee sur la valeur de la probabilite fournie par un radar et la 
valeur de la probabilite anterieurement connue par la meme cellule. 

4. Procede selon Tune quelconque des revendications 1 a 3. dans lequel on 
deduit, des signaux re9us en echo, une information de distance et une 
information angulaire sur les obstacles, et on determine lesdites probabilites 
d'occupation a partir de ces infomiations. 

5. Procede selon Tune quelconque des revendications 1 a 4, comprenant une 
etape de seuillage des resultats de la fusion. 

6. Procede selon Tune quelconque des revendications 1 a 5, dans lequel le 
signal emis par les radars est module en frequence, le signal regu en echo est 
melange a une fraction du signal emis pour, apres elimination de la frequence 
porteuse. former un signal de battement. et la distance d'un obstacle est 
obtenue soit par transformation de Fourrier soit par comptage pendant un 
intervalle de temps predetermine. 

7. Procede selon Tune quelconque des revendications 1 a 6, dans lequel 
remission de chaque radar dure un temps limite. et la logique de repetition est 
codee en vue de Tidentification de la source. 



8. Dispositif pour la detection et la localisation d'obstacles dans 
renvironnement d'un vehicule, caracterise par le fait qu'il comprend una 
pluralite de radars (2) montes sur le vehicule et une unite de traitement (7) 
agencee pour fusionner les donnees fournies par les radars. 

8. Dispositif salon la revendication 8, dans lequel les radars sont a lobe large. 
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